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1 . INTRODUCTION 

Research  Into  computer  vision  and  Image  processing  Is  currently 
being  conducted  In  many  places  for  a great  variety  of  applications.  In  the 
Coordinated  Science  Laboratory  at  the  University  of  Illinois,  emphasis  has 
been  placed  upon  the  development  of  a real-time  vision  system,  that  Is, 
one  which  Is  capable  of  Interacting  with  a dynamic  environment  such  as  an 
assembly  line  In  motion,  or  an  active  robot  manipulator. 

In  order  to  achieve  this  goal,  a standard  vldlcon  television  camera 
has  been  Interfaced  to  a DEC  PDP-10  computer  via  an  8-blt  A/D  converter. 

Only  six  of  the  eight  bits  may  actually  be  selected  at  once.  The  time  re- 
quired to  Input  an  entire  picture  averages  about  40  milliseconds.  Unfortun- 
ately, such  speed  Is  paid  for  In  a loss  of  resolution.  A single  picture 
consists  of  only  238  horizontal  lines  of  252  samples  each. 

In  order  to  obtain  a higher  effective  resolution,  the  TV  camera  has 
been  equipped  with  a computer  controlled  zoom  lens  assembly  which  allows  a 
closer  look  at  a smaller  portion  of  the  original  picture.  Obviously,  there 
Is  a need  for  a device  to  move  the  camera  horizontally  (pan)  and  vertically 

(tut). 
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3.  MECHANICAL  DESIGN 

Since  it  Is  desirable  to  aim  the  camera  at  a specific  point  In  a 
scene,  the  use  of  a discrete  motion  device  such  as  a step  motor  seems  natural. 
Although  a DC  motor  and  brake  combination  could  achieve  similar  results,  It 
would  require  an  analog  servo  to  be  Interfaced  to  the  controller  Instead  of 
the  TTL  compatible  step  motor  driver  cards  commercially  available.  The  choice 
of  a standard  24  step/revolution  step  motor  driving  a 200:1  harmonic  drive 
yields  a resolution  of  0.075  degrees  or  4.5  minutes  of  arc.  This  amount  of 
motion  corresponds  to  less  than  3 picture  cells  at  maximum  zoom.  By  counting 
the  number  of  steps  traveled  from  a reference  position,  an  absolute  accuracy 
of  0.1  degrees  can  be  realized.  The  small  amount  of  error  Is  due  to  error  In 
sensing  the  reference  position  and  the  spring  constant  of  the  harmonic  drive 


unit. 
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4.  CONTROL  ALGORITHM 

4.1.  Basic  Step  Motor  Characteristics 

In  order  to  understand  the  operation  of  this  controller,  it  is 
necessary  to  at  least  have  a superficial  understanding  of  step  motor  character- 
istics. Four  phase,  24  step/revolution  step  motors  such  as  those  used  here  can 
be  thought  of  as  discrete  motion  devices.  Each  phase  has  six  equally  spaced 
equilibrium  points  (at  60  degree  Intervals)  arranged  so  that  the  four  phases 
make  up  a total  of  24  such  points  at  15  degree  intervals.  When  a single 
phase  is  excited,  the  motor  rotor  will  tend  to  move  toward  the  closest  of  the 
six  equilibrium  points  associated  with  it.  By  exciting  the  phases  in  the 
proper  order,  the  rotor  can  be  made  to  turn  in  a desired  direction, 

4.2.  Motion  Sensing 

Rotor  motion  is  detected  by  means  of  an  optical  shaft  encoder  which 
consists  of  a thin  metal  disc  with  24  square  holes  punched  along  its  edge  and 
an  LED/photo-transistor  sensing  device  which  detects  the  presence  or  absence 
of  a hole.  Two  such  sensing  devices  are  placed  on  the  same  disc  so  that  the 
output  shown  in  Figure  1 1'  obtained  when  the  disc  is  rotated.  As  can  be 
seen,  the  space  between  possible  equilibrium  points  is  divided  up  into  four 
distinct  regions.  By  noting  the  order  in  which  the  regions  occur,  the 
direction  of  motion  as  well  as  the  position  of  the  rotor  can  be  determined. 

4.3.  APHASE  Definition 

For  the  purpose  of  describing  the  controller,  define  APHASE  to  be 
the  relation  between  the  actual  rotor  position  and  the  excited  stator  phase. 

APHASE  ■ 0 indicates  that  the  rotor  is  currently  at  an  equilibrium 
point  associated  with  the  excited  phase.  No  net  torque  results. 
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APHASE  “ 1 indicates  that  the  rotor  is  adjacent  to  the  current 
equilibrium  point  on  the  CCW  side.  A force  is  exerted  to  move 
the  rotor  in  the  CW  direction. 

APHASE  ■ 2 indicates  that  the  rotor  is  exactly  between  two 

equilibrium  points.  No  net  torque  results,  but  the  position 
is  unstable. 

APHASE  ■ 3 Indicates  that  the  rotor  is  adjacent  to  the  current 

equilibrium  point  on  the  CW  side.  A force  is  exerted  to  move  the 
rotor  in  the  CCW  direction. 

In  the  following  discussion,  CW  motion  is  sometimes  referred  to  as 
positive,  forward,  or  upward,  CCW  as  negative,  backward,  or  downward. 

4.4.  APHASE  Calculation 

Clearly,  controlling  APHASE  controls  the  acceleration  of  the  motor, 
and  allows  control  of  the  motor's  position.  The  primary  purpose  of  the 
controller  is  to  maintain  the  desired  value  of  APHASE  (denoted  DPHASE).  Since 
the  step  motor  has  only  four  phases,  APHASE  is  calculated  by  a modulo  4 up/down 
counter  using  the  following  algorithm: 

1)  Reset  APHASE  to  0 when  no  motion  is  detected  since  the  rotor  must 
be  at  an  equilibrium  point. 

2)  Increment  (decrement)  APHASE  by  1 when  sending  a step  pulse  to 
excite  the  next  phase  in  the  CW  (CCW)  direction. 

3)  Increment  (decrement)  APHASE  by  1 when  CCW  (CW)  rotor  motion  is 
detected. 

The  controller  adjusts  the  value  of  APHASE  by  sending  step  pulses  to 
the  motor  driver.  Step  direction  Is  determined  according  to  Table  1. 
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Table  1.  Step  Direction  Lookup  Table 


DPHASE  or  Bits  3 and  4 


00 

01 

10 

11 

APHASE 

00 

DN 

UP 

UP 

01 

UP 

-- 

DN 

UP 

10 

DN 

UP 

-- 

DN 

11 

DN 

DN 

UP 

-- 

UP  Indicates  an  UP  or  CW  step 
DN  Indicates  a DOVm  or  CCW  step 
--  Indicates  no  step 


4.5.  DPHASE  Calculation 

The  actual  position  (APOS)  of  either  the  pan  or  the  tilt  axis  Is 

computed  by  counting  the  actual  rotor  steps  which  have  occurred  since  a known 

reference  position.  APOS  Is  Incremented  by  one  for  each  CW  step,  and 

decremented  by  one  for  each  CCW  step.  The  relation  between  APOS  and  the 

desired  position  (DPOS)  determines  DPHASE: 

APOS  - DPOS  ^ DPHASE  - 0 
APOS  < DPOS  ^ DPHASE  - 1 
APOS  > DPOS  >0  DPHASE  « 3 

The  UP  and  DOWN  outputs  of  the  motion  detector  are  fed  to  the  APHASE 
counter.  No  movement  (NM)  Is  a signal  generated  whenever  no  UP  or  DOWN 
signals  have  been  received  for  one  half  second. 
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5.  SAMPLE  MOTION  SEQUENCE 

To  more  fully  illustrate  the  controller  operation,  a detailed  descrip 
tion  of  the  controller  states  is  given  during  a sample  motion  sequence.  Refer 
to  the  Basic  Control  Algorithm  (Figure  2).  Assume  that  the  entire  system  is 
initially  at  rest  with  APOS  and  DPOS  equal  to  1000.  Therefore  NM  is  asserted, 
APHASE  is  0,  DPHASE  is  0,  and  the  shaft  encoders  are  producing  a 2 or  3 output. 

Now  assume  that  the  computer  sets  DPOS  to  2000.  APOS  < DPOS  means  that  DPHASE 

is  set  to  1 and  a forward  step  is  generated  to  set  APHASE  to  1.  Eventually 
the  rotor  will  begin  to  move  in  the  forward  direction  as  a result  of  the 
torque  which  occurs  when  APHASE  is  1.  As  the  shaft  encoders  pass  from  region  4 
to  region  1,  the  motion  detector  produces  an  UP  signal  which  increments  APOS  to 
1001,  decrements  APHASE  to  0,  and  turns  off  NM.  Since  APOS  is  still  less  than 
DPOS,  another  forward  step  is  generated  to  restore  APHASE  to  1. 

This  procedure  is  repeated  until  an  UP  signal  increments  APOS  to  2000 

setting  APOS  equal  to  DPOS,  while  setting  APHASE  to  0.  Since  APOS  equals  DPOS, 

DPHASE  is  set  to  0,  therefore  no  step  pulse  is  generated.  However,  the  inertia 
of  the  mechanical  system  causes  the  rotor  to  keep  moving  in  the  absence  of 
applied  torque.  When  the  next  UP  signal  is  received,  APOS  is  set  to  2001, 
APHASE  to  3.  APOS  greater  than  DPOS  sets  DPHASE  to  3.  Since  APHASE  is  3,  a 
reverse  torque  is  applied  to  the  rotor,  decelerating  it.  APHASE  will  be  kept 
at  3 until  the  rotor  stops  and  reverses  direction. 

APOS  will  again  reach  DPOS,  this  time  from  the  opposite  direction. 
Further  overshoot  will  set  APHASE  to  1.  Mechanical  friction  and  damping 
stabilise  this  procedure.  When  APOS  and  DPOS  are  equal  for  about  one  half 
sacond,  MM  la  assarted  and  the  motion  is  considered  complete. 


BASIC  CONTROL  ALGORITHM 

Figure  2 


. _ 


1 


6.  MODES  OF  CONTROL 


Several  additional  modes  of  control,  somewhat  different  from  those 
described  in  the  previous  sections  have  been  implemented  to  provide  a maxi- 
mum amount  of  flexibility.  They  are  described  briefly  below.  For  complete 
details,  see  Section  10,  Users  Manual. 

Local  Mode  - Inhibits  all  controller  step  generation  but  activates  the 
Joysticks  to  allow  manual  positioning  of  the  camera.  APOS  and 
APHASE  are  still  calculated. 

Stop  Mode  - Inhibits  all  controller  generation. 

Seek  Mode  - Allows  the  computer  to  set  DPOS.  Uses  complete  control 
algorithm. 

Slew  Mode  - Allows  the  computer  to  set  DPHASE.  APOS  and  DPOS  have  no 
effect  upon  step  generation. 

Single  Step  Mode  - Allows  the  computer  to  generate  step  pulses  directly. 
DPHASE  and  APHASE  have  no  effect. 

Load  Mode  - Allows  the  computer  to  set  APOS  for  initialization  purposes. 


7,  MULTI-PHASE  CLOCK  DESIGN  APPROACH 


The  control  algorithm  has  been  implemented  with  TTL  logic  components 
using  a synchronous  multi-phase  design  approach  to  cyclically  execute  the  step 
shown  In  Figure  2.  A synchronous  controller  which  accepts  the  output  of  the 
shaft  encoders  and  produces  appropriate  step  CW  or  step  CCW  signals  was 
designed  using  a multi-phase  clock.  As  used  here,  the  term  "multi-phase 
clock"  refers  to  a number  of  signal  lines  which  are  sequentially  driven  by 
non-overlapping  periodic  pulses. 

This  clock  runs  at  a frequency  much  higher  than  the  desired  stepping 
rate.  In  this  case,  the  master  clock  frequency  from  which  the  various  phases 
are  derived  Is  1 MHz  and  the  number  of  phases  Is  eight,  which  Introduces  a 
worst  case  delay  of  16  microseconds  in  the  control  algorithm.  Synchronous 
operation  eliminates  the  need  to  worry  about  race  conditions  since  there  Is 
sufficient  time  between  phases  for  the  logic  gates  to  settle. 

During  a single  clock  cycle,  the  signals  Cl,  C2,  C3,  C4,  and  C7 
are  sequentially  asserted.  Refer  to  Figure  3 for  an  Illustration  of 
relative  signal  timings.  The  controller  activity  during  each  clock  phase 
Is  described  below. 

7.1.  Clock  Phase  1 

All  asynchronous  signals,  that  Is,  all  signals  which  may  change 
Independently  of  the  clock,  are  latched  so  that  they  may  be  treated  as  static 
for  the  duration  of  the  current  clock  cycle.  These  signals  are: 

El  and  E2,  the  current  shaft  encoder  values; 


master 

CLOCK 


Cl 

C2 

C3 

C7 

STEP  PULSE 

COMPUTER 
DISABLE  - 


ONE  CLOCK  CYCLE 
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CLOCK  SIGNALS 


Figure  3 
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4BRR  and  -ERR,  the  states  of  the  range  soft  limit  switches; 

NM,  the  output  of  the  no  movement  detector;  and 

LINE,  the  value  of  the  LINE/LOCAL  switch. 

Also,  the  PDP-11  Is  Inhibited  from  reading  or  writing  the  controller  status 
register  (STREG)  and  position  register  (PREG).  If  the  NM  flag  Is  high. 
Indicating  no  movement  for  the  past  one  half  second,  the  rotor  Is  assumed  to 
be  stopped,  and  APHASE  Is  set  to  0,  Indicating  an  equilibrium  condition. 

The  actual  position,  APOS,  Is  set  to  the  value  of  PREG  If  the  controller  Is 
In  load  mode  (LDM). 

7.2.  Clock  Phase  2 

The  current  values  of  the  shaft  encoders  (El  and  E2)  are  compared 
to  the  previous  shaft  encoder  values  (PEl  and  PE2),  which  were  saved  during 
the  previous  cycle,  to  determine  the  current  rotor  position  and  direction 
of  travel.  A count  up  signal  (CUP)  Is  generated  when  a count  point  Is  passed 
In  the  CW  direction,  and  a count  down  signal  (CDN)  Is  generated  when  a count 
point  Is  passed  In  the  CCW  direction.  The  count  points  are  located  half  way 
between  the  step  motor  equilibrium  points  as  shown  In  Figure  1.  Therefore, 

CUP  occurs  upon  a transition  from  region  4 to  region  1,  and  CDN  occurs  upon  a 
transition  from  region  1 to  region  4.  If  a CUP  or  CDN  signal  occurs,  the  rotor 
la  moving  from  one  equilibrium  point  to  another.  CUP  causes  the  value  of 
APOS  to  be  Incremented  by  one.  Indicating  that  the  rotor  has  advanced,  and  It 
causes  the  modulo  4 counter  containing  APHASE  to  be  decremented  by  one. 
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Indicating  the  change  in  the  net  torque  on  the  rotor.  In  a like  manner, 

CDN  causes  APOS  to  be  decremented  and  APHASE  to  be  incremented  modulo  4. 

If  either  CUP  or  CDN  occurs,  NM  is  reset  and  begins  timing  for  another 
one  half  second. 

7.3.  Clock  Phase  3 

By  the  time  phase  3 occurs,  the  counter  containing  APOS,  the 
comparator  which  compares  APOS  to  DPOS,  the  logic  which  determines  DPHASE 
from  the  comparator  outputs,  and  the  logic  which  determines  step  genera- 
tion from  STREG,  DPHASE,  or  the  Joysticks,  have  all  reached  steady  state. 

A motor  step  is  initiated  according  to  the  current  controller  mode  as 
follows : 

Local  Mode  - Step  CW  if  JUP  has  been  set  by  the  joystick  clock,  step 
CCW  if  JDN  has  been  set  by  the  Joystick  clock.  If  either  step  is 
generated,  both  JUP  and  JDN  are  cleared. 

Seek  Mode  - Step  CW  or  step  CCW  is  determined  by  comparing  APHASE  to 
DPHASE  according  to  Table  1. 

Slew  Mode  - Step  CW  or  step  CCW  is  determined  by  comparing  APHASE  to 
bits  3 and  4 of  STREG  according  to  Table  1. 

Single  Step  Mode  - Step  CW  is  initiated  if  bit  4 of  STREG  is  set.  Step 
CCW  is  initiated  if  bit  3 of  STREG  is  set.  Both  bits  3 and  4 are 
cleared  if  either  step  is  generated. 

Stop  Mode  or  Load  Mode  - No  steps  are  initiated. 
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l£  a 4£RR  or  -ERR  is  detected,  steps  in  the  CW  or  CCW  direction, 
respectively,  are  inhibited  regardless  of  mode.  The  high  byte  of  STREG  is 
also  loaded  with  the  current  device  status  bits  at  this  time. 

7.4.  Clock  Phase  4 

The  input  half  of  the  position  register  (PREG)  is  loaded  with  the 
current  value  of  APOS.  Also,  the  PDP-11  is  enabled  to  read  and  write  PREG 
and  STREG. 

7.5.  Clock  Phase  7 

If  a step  pulse  was  initiated  during  phase  3,  it  is  now  terminated 
producing  a 4 microsecond  pulse  to  Che  motor  driver.  Also,  Che  current 
encoder  values  are  saved  as  PEI  and  PE2  for  use  in  the  next  clock  cycle. 

7.6.  Unused  Clock  Phases 

The  remaining  clock  phases  are  unused,  but  are  present  so  chat 
the  computer  may  have  sufficient  time  Co  access  the  command  register  and 
the  position  register. 

7.7.  Computer  Simulation 

An  additional  feature  of  using  a synchronous  multi-phase  design 
approach  is  that  the  control  algorithm  can  be  easily  simulated  on  a mini- 
computer. Since  Che  sequential  nature  of  Che  multi-phase  clock  is  analogous 
to  the  sequential  flow  of  a computer  program,  a given  sequential  algorithm 
can  ba  tested  without  the  need  to  construct  elaborate  special  purpose 
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hardware.  The  conerol  algorithm  described  previously  was  programmed  on  a 
PDP-11/40  using  two  binary  digits  In  an  Input  register  to  read  the  shaft 
encoder  values  and  a simple  command  register  to  send  either  a step  CW  or  step 
ecu  pulse  to  the  step  motor  driver.  The  simulation  routine  was  programmed 
In  assembly  language,  and  predicted  a motor  speed  of  200  steps/second,  no 
Instability  problems,  and  high  accuracy.  Because  of  Its  success,  a modified 
version  of  the  simulation  routine  was  used  to  control  the  pan/tllt  head  while 
the  actual  controller  was  being  constructed.  A copy  of  the  simulation 
routine  Is  found  In  Appendix  A. 
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8.  CIRCUIT  DESCRIPTION 

The  following  sections  contain  a detailed  circuit  description  of 
all  major  circuit  blocks,  accompanied  by  schematics.  Figure  4,  the 
General  Block  Diagram  shows  how  these  circuit  blocks  are  interconnected. 
Individual  signals  are  labeled  and  marked  by  off-page  connectors. 

All  logic  gates  and  components  are  standard  TTL  except  for  the 
NE555  timers.  For  clarity,  those  logic  elements  whose  functions  are  completely 
identified  by  their  symbols  have  not  been  labeled.  All  unspecified  inputs 
are  assumed  to  be  at  logic  level  1 except  for  the  SN74173's  whose 
unspecified  inputs  are  tied  to  logic  level  0. 

8.1.  Multi-Phase  Clock  - Figure  5 

The  master  clock  signal  is  generated  by  an  NE555  timer 
connected  for  a stable  operation  and  buffered  by  an  inverter.  This  signal 
is  then  inverted  again  and  used  to  clock  an  SN74163  four  bit  counter.  The 
three  low  order  bits  are  decoded  to  produce  the  signals  'Cl,  'C2,  'C3,  'C4, 
and  'C7  as  shown  in  Figure  3.  A STOP/RUN  switch  is  debounced  and  used  to 
hold  the  counter  at  zero  while  in  the  STOP  position.  The  PDP-11  is 
allowed  to  read  and  write  STREG  and  PREG  while  OK  is  high.  OK  is  set  high 
at  time  C4  or  when  the  STOP/RUN  switch  is  placed  in  the  STOP  position.  OK 
is  reset  at  time  Cl  to  prevent  the  PDP-11  from  Interfering  with  the 
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MULTI -PHASE  CLOCK 


Figure  5 
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8.2.  Joystick  Operation  - Figures  6a  and  6b 

Mechanically,  each  Joystick  axis  consists  of  two  ganged  500K 
potentiometers  and  two  cam  actuated  mlcroswltches  arranged  as  shown  In 
Figure  6a.  In  the  center  position,  both  switches  are  In  a state  such  that 
both  'SJUP  and  'JDN  are  high.  Displacing  the  joystick  from  the  center 
actuates  one  of  the  switches,  depending  upon  the  direction  of  displacement, 
and  causes  either  'SJDN  or  'SJUP  to  fall.  The  potentiometers  on  the  axis 
are  Incorporated  Into  the  timing  circuit  for  the  NE555  which  serves  as  a 
joystick  clock.  They  are  arranged  so  that  the  net  resistance  of  an  axis  Is 
at  a maximum  when  the  joystick  Is  centered  and  a minimum  when  displaced  to 
the  extreme  of  either  side.  Therefore,  the  clock  rate  Increases  as  the  joy- 
stick Is  displaced  from  center,  providing  velocity  control.  This  clock  signal 
Is  "anded"  with  SJUP  and  SJDN  to  provide  directional  Information.  If  the 
step  motor  Is  at  the  limit  of  Its  mechanical  range  In  a particular  direction, 
+ERR  or  -ERR  will  be  high,  effectively  blocking  the  joystick  signal  for  that 
direction.  Otherwise,  a joystick  step  request  Is  made  by  raising  JUP  or  JDN. 
This  request  Is  recognized  at  time  C3  If  the  controller  Is  In  LOCAL  mode  and 
Is  cleared  by  the  generation  of  any  step  pulse  via  'CLRJ.  The  JDONE  switch 
and  the  LINE/LOCAL  switch  are  debounced  and  passed  on  to  other  parts  of  the 
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8.3.  Shaft-Encoder  Decoder  - Figure  7 

The  output  of  the  optical  shaft  encoders  on  the  rotor  shaft  Is 
decoded  Into  count  up  (CUP)  and  count  down  (CDN)  pulses  for  use  In  keeping 
track  of  actual  rotor  position.  The  output  of  the  encoders  Is  buffered  by 
SN7413  Schmitt  triggers,  to  Insure  a high  degree  of  noise  Immunity,  and 
latched  at  time  Cl  so  that  It  may  be  treated  as  static  during  the  remainder 
of  the  control  algorithm.  The  output  of  these  latches  Is  passed  on  to  STREG 
and  Is  also  compared  with  the  previous  encoder  values  via  a pair  of  4 Input 
AND  gates  which  are  sampled  at  time  C2  to  generate  CUP  or  CDN.  At  time  C7, 
the  previous  encoder  values  are  replaced  by  the  new  encoder  values  for  use  In 
the  next  clock  cycle.  COUNT,  which  Is  valid  between  times  Cl  and  C7,  signals 
that  a CUP  or  CDN  pulse  has  been  generated  during  the  current  clock  cycle. 

8.4.  No  Movement  Detector  - Figures  8a  and  8b 

No  movement  Is  signaled  whenever  an  SN74123  retrlggerable  monostable 
Is  not  triggered  by  a CUP  of  CDN  pulse  for  a period  of  one  half  second.  This 
signal,  as  well  as  three  external  signals  (LINE,  4£RR,  and  -ERR)  are  latched 
at  time  Cl  so  that  they  can  be  treated  as  static  for  the  duration  of  the 
clock  cycle. 

8.5.  APHASE  Calculator  - Figure  8c 

The  actual  phase  of  the  rotor  with  respect  to  the  energized  motor 
winding  Is  calculated  by  an  SN74193  up/down  counter.  Since  only  the  two  low 
order  bits  are  used,  APHASE  is  calculated  modulo  4 which  corresponds  to  the 
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four  phases  of  the  step  motor  being  controlled.  If  NM  is  high  at  time  Cl, 
the  motor  is  assumed  to  be  at  equilibrium  and  APHASE  is  set  to  zero  by  clear- 
ing the  counter.  A CDN  or  SUP  pulse  causes  the  counter  to  be  Incremented,  and 
a CUP  or  SDN  pulse  causes  the  counter  to  be  decremented.  The  two  bits  of 
APHASE,  APO  and  API,  are  passed  on  to  the  Automatic  Step  Selector. 

8.6.  Automatic  Step  Selector  - Figure  9 

Automatic  step  selection  is  accomplished  by  comparing  APHASE 
(consisting  of  APO  and  API)  to  DPHASE  (consisting  of  DPO  and  DPI)  using 
a table  lookup  scheme  which  makes  use  of  two  SN74150  16  to  1 multiplexers. 

The  four  bits  APO,  API,  DPO,  and  DPI  are  used  to  address  the  inputs  of  the 
multiplexers  and  produce  UP  or  DN  signals  according  to  Table  1.  A -f£RR 
inhibits  UP  signal  generation,  and  a -ERR  inhibits  DN  signal  generation. 

DPHASE  is  taken  from  the  APOS  to  DPOS  comparator  outputs  (EQ  and  GT)  when 
in  Seek  Hode  (SKM)  and  from  bits  3 and  4 of  STREG  when  in  Slew  Mode  (SLM). 

8.7.  Step  Selectors  - Figure  10 

Step  pulse  initiation  signals  ('lUP  and  *IDN)  are  generated  by  JUP 
and  JDN  when  not  in  LINE  mode,  by  bits  4 and  3 of  STREG  when  in  Single  Step 
Mode  (SSM),  or  by  UP  and  DN  of  the  Automatic  Step  Selector  when  in  Seek 
Mode  or  Slew  Mode  (SKM  or  SLM). 

8.8.  Step  Generator  - Figure  11 

A step  up  or  step  do«m  signal  is  initiated  at  time  C3  depending 
upon  the  value  of  lUP  and  IDN  which  ara  used  to  sat  the  step  generator 
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flip  flops.  These  flip  flops  are  cleared  at  time  C7,  thus  producing  a four 
microsecond  pulse  suitable  for  Input  to  the  motor  driver  cards.  The  signals 
'SUP  and  'SDN  are  used  In  APHASE  calculation  and  are  buffered  by  OR  gates  to 
drive  the  lines  to  the  motor  driver.  'CLRJ  Is  the  logical  "or"  of  'SUP 
and  'SDN  and  Is  used  to  clear  any  joystick  step  request.  If  the 
controller  Is  In  Single  Step  Mode  (SSM),  the  signal  'CLRSS  clears  bits  3 
and  4 of  STREG. 

8,9.  Status  Register 

The  entire  step  motor  controller  Is  designed  to  be  Interfaced  to 
a PDP-11  via  a CSL  PDP-11  Unlbus  Expander.  Specifications  and  Interfacing 
conventions  may  be  found  elsewhere  [3]  . The  Unlbus  Expander  simplifies  address 
decoding  and  Interrupt  requesting  and  transmits  data  over  a bl -directional 
trl-statc  bus  denoted  as  E.DO  through  E.D15. 

8.9.1.  Address  Decoder  - Figure  12 

Only  bits  1 through  3 of  the  address  are  actually  decoded  In  this 
portion  of  the  Interface.  The  Unlbus  Expander  decodes  bits  4 through  17  and 
bit  0,  and  signals  the  controller  via  lines  'E.AHl  through  'E.AH4.  One  of 
these  high  address  lines  Is  Jumpered  to  the  D Input  of  an  SN7442,  and 
address  bits  I,  2,  and  3 are  connected  to  Inputs  A,  B,  and  C respectively. 

The  actual  address  Is  then  selected  by  Jumpering  to  one  of  the  SN7442  outputs. 
When  the  OK  line  is  high,  enabling  the  PDP-11  to  read  and  write  the  status 
register,  a request  to  read  the  selected  address  Is  signaled  by  the  line 
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READ  being  set  high,  and  a request  to  write  the  high  or  low  byte  Is  signaled  by 
WRITE  HI  and  WRITE  LO  respectively.  READ  causes  the  trl-state  drivers  of 
the  status  register  to  be  enabled  onto  the  Expanded  Unlbus  data  lines.  WRITE 
HI  or  WRITE  LO  causes  the  high  or  low  order  byte  of  the  status  register  to 
latch  the  value  currently  on  the  Expanded  Unlbus.  All  normal  PDP-11  Unlbus 
transactions  are  handled  by  the  Expanded  Unlbus  In  conjunction  with  the 
Address  Decoder. 

8.9.2.  Status  Register,  Bits  0 - 3 - Figure  13 

Bits  0,  1,  and  2 of  the  Status  Register  select  the  controller  mode 
(see  Section  6).  The  current  mode  Is  determined  by  the  output  of  the  SN7442 
which  generates  the  signals  'SKM,  'SLM,  'SSM,  and  'LDM.  These  bits  also 
determine  the  done  condition  by  selecting  an  Input  of  the  SN74151  at  time  C3, 
and  using  it  to  set  the  DONE  flag  (bit  7)  via  the  signal  SDONE.  A device 
reset  clears  bits  0,  1,  and  2 via  E.INIT,  placing  the  controller  In  STOP 
mode.  Bit  3 Is  used  elsewhere  for  DPHASE  determination  In  Slew  Mode  and 
STEP  DOWN  generation  In  Single  Step  Mode. 

8.9.3.  Status  Register,  Bits  4 - 7 - Figure  14 

Bit  4,  like  bit  3,  Is  used  elsewhere.  Bit  5 Is  not  used.  Bit  6 
Is  the  Interrupt  enable  bit  which  allows  the  controller  to  request  a 
processor  Interrupt  when  It  Is  set.  Bit  7 Is  the  DONE  bit  which  signals  that 
the  controller  has  finished  a function  sequence.  This  bit  Is  set  by  SDONE 
when  the  controller  Is  on  line.  It  Is  cleared  by  writing  the  low  order  byte 
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of  the  register.  An  interrupt  is  requested  whenever  DONE  goes  high,  a limit 
error  occurs,  or  the  JDONE  switch  is  depressed.  An  Interrupt  is  generated 
by  an  Expanded  Unibus  Interrupt  Request  Card  by  the  logical  "and"  of  the 
signals  INTENAB  and  INTREQ. 

8.9.4.  Status  Register,  Bits  8 - 15  - Figure  15 

The  high  byte  of  the  status  register  is  read  only.  It  contains 
Information  concerning  the  shaft  encoder  states  and  the  states  of  the  JDONE 
and  LINE/IOCAL  switches,  the  no  movement  detector,  and  the  range  limit 
switches.  A READ  causes  this  information  to  be  driven  to  the  Expanded  Unlbus. 

8.10.  Position  Register  - Figure  16 

The  Position  Register  (PREG)  is  actually  an  Expanded  Unlbus  General 
Register  Card  with  a Counter/Comparator  addition.  The  output  side  of  the 
register  feeds  one  set  of  comparator  inputs  and  may  also  be  loaded  into  the 
16-blt  counter  which  feeds  the  other  set  of  comparator  inputs.  Therefore,  the 
comparator  outputs.  Equal  and  Greater  Than  (EQ  and  GT),  pertain  to  the  relation 
between  the  counter  and  the  output  side  of  the  register.  The  input  side  of 
the  register  is  fed  by  the  counter  output.  In  the  step  motor  controller,  the 
counter  contains  the  value  of  APOS,  and  the  input  side  of  the  register 
contains  the  value  of  DPOS. 
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9.  PAN/TILT  USERS  MANUAL 

This  section  Is  Intended  to  serve  as  a guide  to  writing  sofrvare  foe 
the  pan/tilt  controllers.  Both  controllers  appear  absolutely  identical  to  the 
programmer  except  for  their  addresses.  The  terms  Status  Register  (STREG)  and 
Position  Register  (PREG)  apply  to  either  the  pan  or  the  tilt  controller  in  the 
following  section. 

9.1.  Device  Addresses 

765200  - Pan  Status  Register 
765202  - Pan  Position  Register 
300  - Pan  Interrupt  Vector 

765204  - Tilt  Status  Register 
765206  - Tilt  Position  Register 
304  - Tilt  Interrupt  Vector 

9.2.  Status  Register 

Bit  Description 

15  •>  Error.  Actually  the  logical  ”or"  of  bits  13  and  14 
14  - Plus  Limit  Error.  Indicates  an  attempt  to  move  an  axis  beyond 
its  range  in  the  upward  or  CW  direction.  Inhibits  further  steps 
in  that  direction. 

13  - Minus  Limit  Error.  Indicates  an  attempt  to  move  an  axis  beyond 
its  range  in  the  downward  or  CW  direction.  Inhibits  further 
steps  in  that  direction. 

12  - No  Movement  (NM).  Indicates  that  there  has  been  no  rotor 
motion  within  the  previous  1/2  second. 
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11  - Line.  Indicates  that  the  Line/Local  switch  Is  In  the  line 

position,  enabling  the  controller  and  disabling  the  Joysticks. 
10  • Jdone.  Indicates  that  the  Joystick  done  switch  is  depressed. 
This  switch  is  only  a sense  switch  and  has  no  effect  upon  the 
controller. 

9 - El.  Current  value  of  shaft  encoder  1. 

8 • E2.  Current  value  of  shaft  encoder  2. 

7 • Done.  Done  is  set  by  conditions  which  are  determined  by  the 

current  mode.  (See  bits  0-2  below.)  Done  is  reset  by 
writing  the  low  order  byte  of  the  Status  Register. 

6 - Interrupt  Enable.  Causes  the  computer  to  be  interrupted 
by  Error  (Bit  15),  Jdone  (Bit  10),  or  Done  (Bit  7).  It  is 
cleared  by  a reset  instruction. 

5 - Not  used. 

4 - High  order  bit  of  DPHASE  in  Mode  2.  Causes  a CW  step  in 
Mode  3.  Cleared  by  any  step  while  in  Mode  3. 

3 - Low  order  bit  of  DPHASE  in  Mode  2.  Causes  a CCW  step  in 
Mode  3.  Cleared  by  any  step  while  in  Mode  3. 

0-2  - Mode  select  bits.  Cleared  by  a reset  instruction. 

0 - Stop  Mode  (STM).  Inhibits  all  step  pulses  to  the  motor 

driver  cards.  Done  when  NM  is  asserted. 

1 - Saak  Mode  (SKM).  Causes  the  device  to  seek  until  its  actual 

position  (AFOS)  is  equal  to  the  Position  Register.  Done  when 
the  position  is  reached  and  NM  is  asserted. 


Slew  Hode  (SLM).  Causes  the  device  to  accelerate  by  setting 
DPHASE  to  the  contents  of  bits  3-4: 

00  - No  acceleration. 

01  - CW  or  upward  acceleration. 

10  - Not  meaningful. 

11  - CCW  or  downward  acceleration. 

Obviously,  friction  will  limit  speed  and  cause  stopping  In 
the  absence  of  acceleration.  Done  when  AFOS  Is  equal  to 
PREG.  Note  that  Done  Is  not  dependent  upon  NM,  therefore 
the  device  may  still  be  moving. 

Single  Step  Mode  (SSM).  Causes  step  pulses  to  be 
generated  as  specified  by  bits  3 and  4. 

Bit  3 > > Step  downward  or  CCW. 

Bit  4 ■ > Step  upward  or  CW. 

If  both  bits  are  set,  step  pulses  In  both  directions  will 
be  generated,  yielding  unpredictable  results.  Bits  3 and 
4 are  both  cleared  by  step  pulses  while  this  mode  is 
set.  Done  when  the  half  way  point  between  rotor 
equilibrium  points  Is  passed,  that  Is,  when  the  motion 
detector  generates  an  UP  or  a DOWN  signal. 

Load  Mode  (LDM).  The  hardware  actual  position  counter 
(AFOS)  is  loaded  with  the  contents  of  PREG.  Done  Is 
not  generated. 


9.3.  Position  Register 


40 


Writing  the  PREG  address  actually  causes  loading  of  PREG.  Read- 
ing the  PREG  address  does  not  cause  reading  of  PREG!  Instead,  the  number 
obtained  Is  the  current  value  of  APOS.  Changing  PREG  while  In  Seek  Mode 
will  cause  the  device  to  seek  as  usual,  but  will  not  reset  the  Done  bit. 

It  Is  therefore  advisable  to  always  enter  Stop  Mode  before  writing  PREG, 
unless  It  Is  certain  that  the  device  Is  not  currently  In  Seek  Mode. 
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10.  POSSIBLE  IMPROVEMENTS 

The  overall  performance  of  Che  Step  Motor  Controller  for  Che 
pan/tllt  head  has  been  satisfactory.  A step  rate  of  almost  200  steps  per 
second,  idiich  corresponds  Co  an  axis  rotation  rate  of  2.5  RPM,  can  be  ob- 
tained even  with  the  load  imposed  by  Che  TV  camera  and  laser  rangefinder. 

Although  the  discrete  motion  characteristics  of  step  motors 
guarantee  stable  and  repeatable  rest  positions,  they  also  have  been  the 
source  of  some  difficulties.  At  slow  step  rates,  mechanical  resonance  with 
Che  pan/tilc  stand  sometimes  causes  severe  vibration,  precluding  the  use 
of  the  TV  camera  while  in  motion.  An  obvious  solution  would  be  to  use  an 
ordinary  DC  motor  and  brake  combination  in  place  of  Che  step  motor,  while 
still  sensing  rotor  motion  with  optical  shaft  encoders.  Proper  selection 
of  the  DC  motor  would  allow  faster  slew  rates  and  smoother  slow  speed  opera- 
tion at  the  expense  of  a somewhat  more  complicated  controller.  The  brake 
would  facilitate  maintaining  a fixed  position,  and  Che  optical  shaft  en- 
coders would  provide  positional  accuracy  as  good  as  that  in  Che  present 
system. 

Even  in  such  a modified  controller,  Che  synchronous  multi-phase 
design  approach  could  still  be  used  to  full  advantage  in  decoding  the  shaft 
encoder  output,  performing  the  control  algorith,  and  interfacing  to  the  con- 
trolling computer.  As  in  the  current  controller,  this  approach  would  help 
organise  the  control  algorithm  Into  sequential  stepa,  allow  each  step  to  be 
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reduced  to  combinational  logic  design,  avoid  race  conditions,  and  encourage 
accurate  computer  simulation  before  construction. 
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APPENDIX  A 


The  following  is  a MACRO-11  subroutine  used  to  simulate  the  step 
motor  control  algorithm  on  a PDP-11.  The  address  of  the  shaft  encoder  In- 
put and  step  command  register,  and  the  desired  relative  displacement  are 
both  passed  to  the  subroutine  on  the  stack.  A motion  sequence  Is  con- 
sidered complete  when  the  NM  flag  comes  on  after  having  been  off. 


.TITLE  STEP  MOTOR  CONTROLLER  SIMULATICW 
;R0  > CURRENT  ENCODER  POSITION 

;R1  “ ACTUAL  PHASE  (APHASE) 

;R2  - PREVIOUS  ENCODER  POSITION 

;R3  » DESIRED  PHASE  (DPHASE) 

;POS  - NUMBER  OF  STEPS  WHICH  THE  MOTOR  IS  TO  TAKE  IN 

; THE  CW  DIRECTION  (NEGATIVE  HUMBER  INDICATES  CCW) 


RNl 

» 400 

: REGION  1 WHEN 

El  AND  NOT  E2 

RNA 

= 0 

; REGION  4 WHEN 

NOT  El  AND  NOT  E2 

CM 

- 176377  ;MASK  TO  GET  ENCODER  VALUES 

NM 

10000 

;NM  BIT 

PLERR 

- 40000 

LIMIT  ERROR 

BIT 

MI  ERR 

- 20000 

:-  LIMIT  ERROR 

BIT 

.GLOBL 

MOVE,$SAV5 

.CSECT 

CCWTR 

MOVE: 

JSR 

R1,$SAV5 

;SAVE  REGS 

LIO: 

BIT 

#NM,@16 . (SP) 

; CHECK  NO  MOVQIENT  FLAG 

BEQ 

LIO 

: LOOP  UNTIL  ASSERTED 

CLR 

R1 

{APHASE  IS  0 WHEN  STOPPED 

MOV 

#-l,R2 

;INIT  PREVIOUS  POSITION 

MOV 

14.(SP),POS 

;GET  POS  FROM  STACK 

MOVB 

#l,WMOV 

;SET  FLAG  TO  WAS  NOT  MOVING 

UO: 

MOV 

@16.  (SP),R0 

;GET  CURRENT  POSITION 

BIT 

#NM,RO 

;IS  ROTOR  MOVING? 

BEQ 

L21 

;YES,;  SKIP 

TSTB 

WHOV 

;EUE  HAS  ROTOR  MOVING? 

BNE 

L22 

;NO,  IT  HASN'T  STARTED  YET 

CLR 

RO 

;ELSE  IT  HAS  STOPPED  AND 

RtS 

PC 

: IT'S  TIME  TO  RETURN 

L21: 

CUB 

WMOV 

iSET  FUG  TO  MOVING 

L22: 

BIC 

#CM,RO 

;MASK  OFF  ENCODER  BITS 

1.1.  m 
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CMP 

R2,#RNA 

;WAS  PREVIOUS  POSITION  RN4? 

BEC 

L70 

;YES,  BRANCH 

CMP 

R2 ,#RN1 

;WAS  PREVIOUS  POSITION  RNl? 

BEQ 

L80 

;YES,  BRANCH 

L30: 

MOV 

RO,R2 

;SAVE  CURRENT  POSITION 

TST 

POS 

;SEE  IF  POS  IS  0 

BEQ 

lAO 

;SK1P  IF  IT  IS 

BPL 

L50 

;SKIP  IF  MORE  STEPS  TO  GO 

MOV 

#3,R3 

;POS  < 0,  SET  DPHASE  TO  -1 

BR 

L60 

lAO: 

CLR 

R3 

;POS  = 0,  SET  DPHASE  TO  0 

BR 

L60 

L50: 

MOV 

#1,R3 

;POS  > 0,  SET  DPHASE  TO  1 

LbO: 

MOV 

R3,RA 

;MOV  DPHASE  TO  R4 

ASL 

R4 

; SHIFT  LEFT  BY  2 BITS 

ASL 

R4 

BIS 

R1,R4 

;0R  IN  APHASE 

MOVB 

STEP(R4),R4 

;LOOK  UP  DIRECTION  IN  TABLE 

BEQ 

L20 

;LOOP  IF  NO  STEP 

CMP 

R4,#5 

;CW  STEP? 

BEQ 

Lb2 

;YES,  SKIP 

BIT 

#MIERR.@16. (SP) 

;EUE  CHECK  FOR  MINUS  LIMIT 

BEQ 

L64 

;SKIP  IF  NO  ERROR 

MOV 

#-l,RO 

LIMIT  ERROR 

RTS 

PC 

L62: 

BIT 

#PLERR,GI16 . (SP) 

; CHECK  FOR  PLUS  LIMIT 

BEQ 

L64 

;SKIP  IF  NO  ERROR 

MOV 

#l,RO 

;+  LIMIT  ERROR 

RTS 

PC 

; RETURN 

L64: 

MOV 

R4  ,@16 . (SP) 

;STEP  IN  INDICATED  DIRECTION 

ADD 

R4,R1 

: ADJUST  PHASE 

BIC 

#177774, R1 

; MODULO  4 

BR 

L20 

L70: 

CMP 

RO,#RNl 

;IS  CURRENT  POSITION  RNl? 

BNE 

UO 

;N0,  BRANCH 

DEC 

POS 

;EUE  HAS  MOVED  CW 

ADD 

#3,R1 

; ADJUST  APHASE 

BIC 

#177774, R1 

: MODULO  4 

BR 

UO 

L80 

CMP 

RO,#RN4 

;IS  CURRENT  POSITION  RN4? 

BNE 

UO 

;N0,  BRANCH 

INC 

POS 

;EUE  HAS  MOVED  CCW 

INC 

R1 

;ADJUST  APHASE 

BIC 

#177774,R1 

; MODULO  4 

BR 

UO 

• 

ofimjki 
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;STEP  DIEIECTION  LOOKUP  TABLE: 

; 0 - NO  STEP 

; 5 - STEP  FORWARD  OR  CW 

; 7 ° STEP  BACKWARD  OR  CCW 

STEP:  .BYTE  0,7, 5, 5 

.BYTE  5, 0,7, 5 
.BYTE  7, 5,0, 7 
.BYTE  7, 7, 5,0 


POS:  .W(»D  ; DISPLACEMENT 

WMOV:  .BYTE  ;WAS  MOVING  FUG 

.EVEN 
.END 
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